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Abstract of DE10111729 

The camera (2) is calibrated using a calibration board (3) or the body (5) itself, to which a number of 
known target points (4) can be attached, or by controlled movement of the camera relative to a single 
target point. The camera is moved using a swinging head (1) so that it is targeted on at least three 
fixed characteristic points (6, 6', 6) on the body whose body related coordinates are known. From the 
calibration and fixed-point measurements, the spatial position of the body can be determined. 
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® Verfahren zur Bestlmmung der Lage eines Korpers im Raum 

© DieErfindung beziehtsich auf ein Verfahren zur Bestim- 

mung der Lage eines Korpers im Raum mit Hirfe einer 

elektronischen Kamera mit Bildverarbeitung. Die Kamera 

wird unter Verwendung einer Kalibriertafel oder dem Kor- 

per selbst, auf welch er bzw. welch em mehrere bekannte 

Zielpunkte angebracht sind, oder mit Hilfe einer kontrol- 

lierten Bewegung der Kamera und einem efnzelnen Zlel- 

punkt, kalibriert Die Kamera wfrd zur Bildaufnahme mit 

Hilfe eines Schwenk-Neige-Kopfes hintereinander auf 

mindestens drei auf dem Korper bestimmte Markmale ge- 

richtet dessen kdrperfeste Koordinaten jeweils bekannt 

sind. Die Bf Id koordinaten der drei Merkmale werden mit 

Hilfe der elektronischen Bildverarbeitung featgeatellt Zu- 

sammen mit diesen, den Kalibrierparamtem, der Kamera 

und den bekannten korperfesten Koordinaten der Merk- 
i male wird die Lage des Korpers im Raum bestimmt 
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Bescfarefbung 


[0001] Die Erfindung bezieht sich auf ein Verfahren zur 
Bestimmung der Lage eines Korpers im Raum ndt einer 
elektronischen Kamera rait BiMverarbeitung. 
[0002] Es ist bekannt, die Lage eines Korpers im Raum 
rait Hilfe mehrerer urn dicscn Korper platzierten Kameras 
zu bestimmen, welcbe alle in einem gemcinsamen Koordi- 
natensystem kalibriert sind und welche keinen gerneinsa- 
men Tbil des Korpers sehen. Hierzu ist bspw. aus der 
EP 0 911 603 Al ein Verfahren zur optiscben Bestimmung 
der Lage eines eodlicben starren Korpers in einem raumli- 
chen Koordinatensystem bekannt, bei welchem aus einer 
Auswahl von mehreren, auf dem starren Korper vorhande- 
nen Linien oder Kanten, die in Bezug zum korpereigenen 
Koordinatensystem stehen, jede Linie oder Xante fur sich in 
einem ihr zugeordneteo ebenen Koordinatensystem abgebil- 
det wird und wobei die Lage jedes ebenen Koordinatensy- 
stems auf das raurnliche Koordinatensystem bezogen isL 
Diese Vorgehensweise hat jedoch den Nachteil, dass immer 
mindestens drei Kameras benotigt werden, urn die Lage des 
Korpers im Raum zu bestimmen. 

[0003] Es ist feraer bekannt, die Lage eines Korpers im 
Raum aus mehreren Ansicbten desselben TeiLs des Korpers 
zu bestimmen. Hierzu ist aus der EP 0 763 406 Al ein Ver- 
fahren zum Bestimmen der Lage eines Korpers im Raum 
mil mehreren mit diesen zusammenwirkenden raumlicb ge- 
trennten elektronischen Kameras mit Bildverarbei tung be- 
kannt, wobei jede von mindestens drei raurnlich getrennten 
elektronischen Kameras mit Bildverarbei rung, welcbe bei 
deren Einmessen eine ihr zugeordnete Kalibriertafel mit 
Punktmuster aurnimmt, deren Bilder sowie das Punktmuster 
zur Bestimmung der Lage der einzelnen Kameras im Raum 
verarbeitet und deren Lage gespei chert werden, wobei eine 
Vermessung der Kalibriertafeln zueinander getrennt hiervon 
erfolgt und diese Werte ebenfalls gespeichert werden, an- 
schliefiend der Korper in den Raum z wise hen den elektroni- 
schen Kameras verbracht wird, je ein charakteristi scher 
Punkt auf dem in den Raum verbrachten Korper in je einer 
diesem zugeordnete n elektronischen Kamera abgebildet 
wird, dass dessen Lage in Bild mit seiner konstruktiven vor- 
gegebenen Position des charakteristLschen Punktes auf den 
in den Raum verbrachten Korper zusammen mit den gespei- 
cherten Werten verarbeitet wird, und alle derart verarbeite- 
ten Werte die Lage des in dem Raum verbrachten Korpers in 
den sechs ra'umlichen Freiheitsgraden charakterisieren, 
Diese Vorgehensweise hat den Nachteil, dass entweder meh- 
rere Kameras benotigt werden oder eine Kamera so urn den 
Korper bewegt werden muss, dass der gleiche Tbil des Kor- 
pers aus Yerschiedenen An sich ten gesehen wird. Im letzie- 
ren Fall ist eine Bewegungseinheit fur die Kamera notwen- 
dig, welche die Kamera liber langere Strecken positionieren 
muss in Abhangigkeit von der Grdfie des Kdrpers. 
[0004] Aufgabe der vorliegenden Erfindung ist es, ein 
Verfahren der eingangs g en an n ten Art vorzuschlagen, wel- 
ches auf einfache und wirtschaftlichere Weise ausgefQhrt 
werden kann. 

[0005] Hierzu wird im Rahmen der Erfindung bspw. vor- 
geschLagen, die Kamera mit Hilfe einer Kalibriertafel oder 
dem Korper selbst, auf welcber bzw. welchem mehrere be- 
kannte Zielpunkte angebracht sind, oder mit Hilfe einer kon- 
troUierten Bewegung der Kamera und einer einzelnen 
Marke kalibriert, die Kamera wird zur Bildaufnahme mit 
Hilfe eines Schwenk-Neige-Kopfes hintereinander auf min- 
destens drei auf den Korper besrirnraten Merkmale gerich- 
tet, dessen korperfeste Koordinaten jeweils bekannt sind, 
Harm werden die Bildkoordinaten der drei Merkmale mit 
Hilfe der elektronischen Bildverarbei tung festgestellt und 


schlieBlich wird aus den Kalibrierparametern der Kamera 
und den bekannten korperfesten Koordinaten der Merkmale 
die Lage des Korpers im Raum bestimmt. 
[0006] Die elektrcmsche Kamera kann eine an sich be- 

5 kannte CCD (Computer-Controlled Display)-Kamera sein. 
Die der Kalibrierung dienenden Zielpunkte konnen dem- 
nach entweder auf einer Kalibriertafel oder auf dem Korper 
selbst vorgesehen sein. "Zielpunkte" sind naturlich in der 
Praxis kleine Zielflachen geringen Querschnitts beliebiger, 

10 aber vorzugsweise kreisrunder Gestalt Die Kamera braucht 
lediglich von einem Schwenk-Neige-Kopf unterstfltzt zu 
sein, so dass eine Bewegungseinheit, welche die Kamera 
Qber langere Strecken in Abhangigkeit von der Gr66e des 
Korpers positionieren muss, entbehriich ist Die Bildkoordi- 

15 naten der drei Merkmale auf dem Korper lassen sich mit 
Hilfe der elektronischen Bildverarbeitung auf einfache 
Weise feststeUen. Ebenso einfach ist dann die Bestimmung 
der Lage des Korpers, wenn die Bildkoordinaten der drei 
Merkmale, die Kalibrierparameter der Kamera und die kor- 

20 perfesten Koordinaten der Merkmale zur Verrugung stehen. 
Zur Erhohung der Genauigkeit konnen durch \ferscbwenken 
der Kamera ohne wei teres auch mehr als drei auf dem Kor- 
per bestimmte Merkmale zur Bildaufnahme benutzt werden. 
[0007] Start die mehreren bestimmten Merkmale nachein- 

25 ander zur Bildaufnahme heranzuzieheo, ist es auch mdglich, 
bei ein und derselben BiMaumahme mehr als ein auf dem 
Korper bestimmtes Merkmal, dessen BUdkoordinaten fest- 
gestellt werden sollen, zu benutzen. 

[0008] In Weiterbildung des Erfindungsgedankens wird 
30 femer vorgeschlagen, eine Kamera mit Autofokus und/oder 
Zoom zu verwenden. Fur die jeweilige Bildaufnahme wer- 
den dann die entsprechenden Einstellungen der Kamera mit 
kalibriert 

[0009] Bei der Ausfuhrung des ertmdungsgemaBen Ver- 
35 fahrens kann man bspw. so vorgehen, dass zunachst der er- 
forderliche Zoom der Kamera eingestellt, dann die Kamera 
auf die entsprechenden Merkmale geschwenkt und die Au- 
tofokus-Hnstellungen vorgenommen oder gesteuerte Fo- 
kuseinstellungen vorgenommen werden. Erst dann wird die 
40 Kalibrierung der Kamera durchgefuhrt, indem die Kamera 
z, B. auf die Kalibriertafel verschwenkt wird, um die not- 
wendigen KaHbrierungsparameter zu bestimmen, Dann 
wird die Kamera auf die entsprechenden Merkmale des Kor- 
pers zur Bildaufnahme und -auswertung zuruckgeschwenkt. 
45 Hierbei werden sowohl interne (Zoom und Autofokus) als 
auch externe Lagkoordinaten Parameter der Kamera bertick- 
sichtigt, 

[0010] Fur Routineuntersuchungen, bspw. an einer Ferti- 
gungsstrafie fur Automobile, kann es auch zweckmaBig 
SO sein, dass die Kalibrierung der Kameras vor der eigentlichen 
Lagebestimmung ausgefUhrt und die Kalibrierungsparame- 
ter elektronisch abgespeichert werden, so dass sie danach je- 
dexzeit zur Verrugung stehen. 

[0011] Das erfindungsgemMBe Verfahren schliefit nicht 
SS aus, dass zur Erhohung der Genauigkeit der Lagebestim- 
mung oder zur Bestimmung der Lage sehr komplexer Kor- 
per auch mehrere auf Sch wen k-Neige-Kopf en gelagerte Ka- 
meras verwendet werden. 

[0012] Gemafi einem altemativen Erfmdungsvorschlag 
60 wird mindestens ein Merkmal auf dem Objekt benutzt und 
dieses unter mindestens zwei verschiedenen Einstellungen 
des Schrank-Neige-Kopfes betrachtet Dabei kann die Be- 
wegung des Schwenk-Neige-Kopfes mit zur Bestimmung 
der 3D-Lage benutzt werden. 
65 [0013] Weitere Ziele, Merkmale, Vbrteile und Anwen- 
dungsmoglichkeiten der Erfindung ergeben sich aus der 
nachfolgenden Beschreibung von Ausfunrungsbeispielen 
anhand der Zeichnung. Dabei bilden alle beschriebenen und/ 
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oder bildlich dargestellten Merkmale fur sdch oder in belie- 
biger Kombination den Gegenstand der Erfindung auch un- 
abhangig von Lhrer Zusammenf assung in einzelnen Anspru- 
chen oder deien Rttckbeziehung. 

[0014] AusfQhrungsbeispiele der Erfindung werden nach- 
folgend anhand der Zeichnung naher erlautert 
[0015] Wie in der Zeichnung dargestellt, wird die auf ei- 
nem Schwenk-Neige-Kopf 1 monucrte Kamera 2 zunachst 
mit Hilfe einer in der Nahe angebrachten Kalibriertafel 3, 
welche mehrere Zielpunkte (Markierungen) 4 bekannter 
Koordinaten kalibriert. Bei dieser Kalibrierung weiden die 
intemen und extemen Parameter der Kamera bestimmt, also 
bspw, Autofokus, Zoom und die Lagekoordinaten. Die Kali- 
brierung kann auch nrit Hilfe von Zielpunkten (4) erfolgen, 
welche auf dem Objekt 5 sclbst angebracht sind, dessen 
Lage im Raum bestimmt werden solL Es ist auch moglich, 
die Kalibrierung mit einem aquivalenten Verfahren dazu 
vorzunehmen, bspw. durch die kontrollierte Bewegung der 
Kamera 2 und der Erkennung eines einzigen Zielpunktes 
bzw. einer einzigen Markierung. 

[0016] Ist die Kalibrierung erfolgt, wird die Kamera 2 mit 
Hilfe des Schwenk-Neige-Kopfes 1 auf ein erstes Merkmal 
6 eingestellt. Von diesem Merkmal sind die kSrperfesten 
Kooidinaten bekannt. Das Merkmal 6 kann punk!- oder lini- 
enforrrag sein. Bei einem hnienforrnigen Merkmal branchen 
ausgezeichnete Punkte rricht zu erkennen sein. 
[0017] Sodann wird mit Hilfe der Kamera 2 ein Bild des 
Korpers 5 mit dem ersten Merkmal 6 aufgenommen. Da- 
nach wird der Schwenk-Neige-Kopf 1 so eingestellt, dass 
von der Kamera 2 ein zweites Merkmal 6' auf den Korper 5 
gesehen und aufgenommen werden kann. \bn dem Merk- 
mal 6 1 sind die korperfesten Koordinaten ebenfalls bekannt. 
Das Gleiche erfolgt mit Hilfe eines dritten Merkmals 6" auf 
dem Korper 5. 

[0018] In den drei so aufgenommenen Bildern werden die 
BQaUtoordinaten der Merkmale 6, 6\ 6" mit Hilfe einer elek- 
tronischen Bildverarbeitung bestimmt Aus diesen kann 
dann zusammen mit den Kalibrierparametexn der Kamera 2 
und den bekannten korperfesten Koordinaten der Merkmale 
6, 6\ 6" die Lage des Korpers 5 im Raum bestimmt werden. 
[0019] Es ist auch moglich, mehr als drei Merkmale 6, 6', 
6" fur die Lagebestimmung des Korpers 5 im Raum zu be- 
nutzen. Femer ist es auch mSglich, mehr als ein Merkmal 6, 
6\ 6 N pro Bild zu benutzen. 

[0020] Die Kamera 2 kann mit Autofokus und/oder Zoom 
ausgestattet sein, Zur Kalibrierung gehort dann auch die Au- 
tofokus- und/oder Zoom-Einstellung der Kamera. 
[0021] Die Kalibrierung der Kamera 2 kann auch getrennt 
von der Lagebestimmung des Korpers 5 erfolgen, bspw. vor- 
her. Dann kbnnen die KaBbrienmgsparameter fur alle spate- 
ren Anwendungen abgespci chert werden. 
[0022] Es ist auch moglich, zur Lagebestimmung des KOr- 
pers 2 im Raum an der Kamera 2 zunachst den erforderli- 
chen Zoom einzustellen, dann die Kamera 2 zu dem ersten 
Merkmal 6 zu schwenken, die Autofokus-Einstellung 
diirchzuruhren, die Kamera 2 auf die Kalibrieitafel 3 zu 
schwenken, die notwendigen Kalibrierparameter zu bestim- 
men, dann die Kamera 2 zuruckzuschwenken und die ent- 
sprechende Messung an dem ersten Merkmal 6 durchzufuh- 
ren. Entsprechendes gilt fur die weiteren Merkmale 6\ 6". 
[0023] Statt Verwendung der Kalibriertafel 3 kann die Ka- 
librierung auch mit Hilfe des Objektes 5 sclbst durchgefuhrt 
werden, wenn dieses dazu geeignet ist, also geeignete Ziel- 
punkte 4 aufweist 

[0024] Wenn, eine weitere Moglichkeit der Erfindung, 
mehrere Kameras 2 mit Schwenk-Neige-Kopf 1 eingesetzt 
werden, konnen auch teilweise oder ganz uberiappende 
Bildf elder benutzt werden. 


Bezugszeichenliste 

1 Schwenk-Neige-Kopf 

2 Kamera 

5 3 Kalibriertafel 

4 Zielpunkte 

5 Korper 

6, 6\ 6" Merkmale 
10 Patentanspruche 

1. Verfahren zur Bestimmung der Lage eines Korpers 
(5) im Raum unter Verwendung einer elektronischen 
Kamera (2) nrit Bildverarbeitung, wobei die Kamera 

15 (2) nrit Hilfe einer Kalibriertafel (3) oder dem Korper 
(5) selbst, auf welcher bzw. welchem mehrere bekannte 
Zielpunkte (4) angebracht sind, oder mit Hilfe einer 
kontrollierten Bewegung der Kamera (2) und einem 
einzelnen Zielpunkt (4) kalibriert wird, die Kamera (2) 

20 zur Bildaufnahme mit Hilfe eines Schwenk-Neige- 
Kopfes (1) hintereinander auf mindestens drei auf dem 
Korper (5) bestimmte Merkmale (6, 6', 6") gerichtet 
wird, deren korperfeste Koordinaten jeweils bekannt 
sind, die Bildkoorclinaten der drei Merkmale (6, G, 6") 

25 mit Hilfe der elektronischen Bildverarbeitung festge- 
stellt werden und wobei schlieBlich aus diesen, aus den 
KaHbrierparametern der Kamera (2) und aus den be- 
kannten korperfesten Koordinaten der Merkmale (6, 6\ 
6") die Lage des Korpers (5) im Raum bestimmt wird. 

30 2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass durch Verschwenken der Kamera (2) mehr als 
drei auf dem Korper (5) bestimmte Merkmale (6, 6', 6") 
zur Bildaufnahme benutzt werden. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekenn- 
35 zeichnet, dass bei einer Bildaufnahme mehr als ein auf 

dem Korper (5) bestimmtes Merkmal (6, <?, 6"), dessen 
Bildkoordinaten festgestellt werden, benutzt wird. 

4. Verfahren nach einem der vorhergehenden Ansprii- 
che, dadurch gekennzeichnet, dass eine Kamera (2) nrit 

40 Autofokus und/oder Zoom verwendet wird, wobei flir 
die jeweilige Bildaufnahme die entsprechenden Ein- 
stellungen der Kamera (2) mit kalibriert werden. 

5. Verfahren nach einem der vorhergehenden Ansprfl- 
che, dadurch gekennzeichnet, dass zunachst der erfor- 

45 deriiche Zoom der Kamera (2) eingestellt, dann die Ka- 
mera (2) auf die entsprechenden Merkmale (6, 6\ 6") 
geschwenkt und die Autofokus-Einstellung vorgenom- 
men werden, dann die Kalibrierung der Kamera (2) 
durchgefuhrt wird, indem die Kamera (2) z, B. auf die 

50 Kalibriertafel (3) verschwenkl wird, urn die notwendi- 
gen Kalibrierparameter zu bestimmen, und dann die 
Kamera (2) auf die entsprechenden Merkmale (6, 6\ 
6") des Korpers (5) zur Bildaufnahme und -auswertung 
zuriick geschwenkt wird 

S5 6. Verfahren nach einem der vorhergehenden Ansprii- 
che, dadurch gekennzeichnet, dass die Kalibrierung der 
Kamera (2) vor der eigentlichen lagebestimmung aus- 
gefuhrt und die Kalibrierparameter elektronisch abge- 
speichert werden. 

60 7. Verfahren nach einem der vorhergehenden AnsprQ- 
che, dadurch gekennzeichnet, dass mehrere auf 
Schwenk-Neige-Kopfen (1) gelagerte Kameras (2) ver- 
wendet werden. 

8. Verfahren insbesondere nach einem der vorberge- 
65 hen den Anspruche, dadurch gekennzeichnet, dass min- 
destens ein Merkmal (6, 6\ 6") auf dem Korper (5) be- 
nutzt und dieses unter mindestens zwei verse hiedenen 
Einstellungen des Schwenk-Neige-Kopfes (1) betrach- 
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tet wird. 
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